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Method for determining the position in space of a body, using electronic 
camera with image processing, which is moved using swinging head to be 
targeted on three fixed characteristic points on body 
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Abstract of DEI 01 11 729 

The camera (2) is calibrated using a calibration board (3) or the body (5) itself, to which a number of 
known target points (4) can be attached, or by controlled movement of the camera relative to a single 
target point. The camera is moved using a swinging head (1) so that it is targeted on at least three 
fixed characteristic points (6, 6', 6) on the body whose body related coordinates are known. From the 
calibration and fixed-point measurements, the spatial position of the body can be determined. 
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(54) Verfahren zur Bestimmung der Lage eines Korpers im Raum 

@ DieErfindung beziehtsich auf ein Verfahren zur Bestim- 
mung der Lage eines Korpers im Raum mit Hilfe einer 

elektronischen Kamera mit BNdverarbeitung. Die Kamera 

wird unter Verwendung einer Kalibriertafel oder dem Kor- 

per selbst, auf welcher bzw. welchem mehrere bekannte 

Zielpunkte angebracht sind, oder mit Hilfe einer kontrol- 

lierten Bewegung der Kamera und einem einzelnen Ziel- 

punkt, kalibriert. Die Kamera wird zur Bildaufnahme mit 

Hilfe eines Schwenk-Neige-Kopfes hintereinander auf 

mindestensdrei auf dem Korper bestimmte Merkmale ge- 

richtet, dessen korperfeste Koordinaten jeweils bekannt 

sind. Die Bildkoordinaten der drei Merkmale werden mit 

Hilfe der elektronischen Bildverarbeitung festgestellt. Zu- 

sammen mitdiesen, den Kalibrierparamtern, der Kamera 

und den bekannten korperfesten Koordinaten der Merk- 
f male wird die Lage des Korpers im Raum bestimmt. 
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Beschreibung 


[0001] Die Erfindung bezieht sich auf em Verfahren zur 
Bestimmung der Lage eines Korpers im Raum mat einer 
elektronischen Kamera mit Bildverarbeitung. 
[0002] Es ist bekannt, die Lage eines Korpers im Raum 
mit Hilfe mehrerer um diesen Korper platzierten Kameras 
zu bestimmen, welche alle in einem gemeinsamen Koordi- 
natensystem kalibriert sind und welche keinen gemeinsa- 
men Teil des Korpers sehen. Hierzu ist bspw. aus der 
EP 0 911 603 Al ein Verfahren zur optischen Bestimmung 
der Lage eines endlichen starren Korpers in einem raumli- 
chen Koordinatensystem bekannt, bei welchem aus einer 
Auswahl von mehreren, auf dem starren Korper vorhande- 
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schlieBlich wird aus den Kalibrierparametern der Kamera 
und den bekannten korperfesten Koordinaten der Merkmale 
die Lage des Korpers im Raum bestimmt. 
[0006] Die elektronische Kamera kann eine an sich be- 
kannte CCD (Computer- Controlled Display)-Kamera sein. 
Die der Kalibrierung dienenden Zielpunkte konnen dem- 
nach entweder auf einer Kalibriertafel oder auf dem Korper 
selbst vorgesehen sein. "Zielpunkte" sind natiirlich in der 
Praxis kleine Zielflachen geringen Querschnitts beliebiger, 
aber vorzugsweise kreisrunder Gestalt. Die Kamera braucht 
lediglich von einem Schwenk-Neige-Kopf unterstutzt zu 
sein, so dass eine Bewegungseinheit, welche die Kamera 
iiber langere Strecken in Abhangigkeit von der GroBe des 
Korpers positionieren muss, entbehrlich ist. Die Bildkoordi- 


nen Linien oder Kanten, die in Bezug zum korpereigenen 15 naten der drei Merkmale auf dem Korper lassen sich mit 

Koordinatensystem stehen, jede Linie oder Kantefiir sich in Hilfe der elektronischen Bildverarbeitung auf einfache 

einem ihr zugeordneten ebenen Koordinatensystem abgebil- Weise feststellen. Ebenso einfach ist dann die Bestimmung 

det wird und wobei die Lage jedes ebenen Koordinatensy- der Lage des Korpers, wenn die Bildkoordinaten der drei 

stems auf das raumliche Koordinatensystem bezogen ist. Merkmale, die Kalibrierparameter der Kamera und die kor- 

Diese Vorgehensweise hat jedoch den Nachteil, dass immer 20 perfesten Koordinaten der Merkmale zur Verfiigung stehen. 


mindestens drei Kameras benotigt werden, um die Lage des 
Korpers im Raum zu bestimmen, 

[0003] Es ist ferner bekannt, die Lage eines Korpers im 
Raum aus mehreren Ansichten desselben Teils des Korpers 
zu bestimmen. Hierzu ist aus der EP 0 763 406 Al ein Ver- 
fahren zum Bestimmen der Lage eines Korpers im Raum 
mit mehreren mit diesen zusammenwirkenden raumlich ge- 
trennten elektronischen Kameras mit Bildverarbeitung be- 
kannt, wobei jede von mindestens drei raumlich getrennten 


Zur Erhohung der Genauigkeit konnen durch Verschwenken 
der Kamera ohne weiteres auch mehr als drei auf dem Kor- 
per bestimmte Merkmale zur Bildaufnahme benutzt werden. 
[0007] Statt die mehreren bestimmten Merkmale nachein- 
25 ander zur Bildaufnahme heranzuziehen, ist es auch moglich, 
bei ein und derselben Bildaufnahme mehr als ein auf dem 
Korper bestimmtes Merkmal, dessen Bildkoordinaten fest- 
gestellt werden sollen, zu benutzen. 

[0008] In Weiterbildung des Erfindungsgedankens wird 


elektronischen Kameras mit Bildverarbeitung, welche bei 30 ferner vorgeschlagen, eine Kamera mit Autofokus und/oder 

deren Einmessen eine ihr zugeordnete Kalibriertafel mit Zoom zu verwenden. Fur die jeweilige Bildaufnahme wer- 

Punktmuster aumimmt, deren Bilder sowie das Punktmuster den dann die entsprechenden Einstellungen der Kamera mit 

zur Bestimmung der Lage der einzelnen Kameras im Raum kalibriert. 

verarbeitet und deren Lage gespeichert werden, wobei eine [0009] Bei der Ausfuhrung des erfindungsgemaBen Ver- 

Vermessung der Kalibriertafeln zueinander getrennt hiervon 35 fahrens kann man bspw. so vorgehen, dass zunachst der er- 

erfolgt und diese Werte ebenfalls gespeichert werden, an- forderliche Zoom der Kamera eingestellt, dann die Kamera 

schlieBend der Korper in den Raum zwischen den elektroni- auf die entsprechenden Merkmale geschwenkt und die Au- 

schen Kameras verbracht wird, je ein charakteristischer tofokus-Einstellungen vorgenommen oder gesteuerte Fo- 

Punkt auf dem in den Raum verbrachten Korper in je einer kuseinstellungen vorgenommen werden. Erst dann wird die 

diesem zugeordneten elektronischen Kamera abgebildet 40 Kalibrierung der Kamera durchgefuhrt, indem die Kamera 

wird, dass dessen Lage in Bild mit seiner konstruktiven vor- z. B. auf die Kalibriertafel verschwenkt wird, um die not- 

gegebenen Position des charakteristischen Punktes auf den wendigen Kalibrierungsparameter zu bestimmen, Dann 

in den Raum verbrachten Korper zusammen mit den gespei- wird die Kamera auf die entsprechenden Merkmale des Kdr- 

cherten Werten verarbeitet wird, und alle derart verarbeite- pers zur Bildaufnahme und -auswertung zuruckgeschwenkt. 

ten Werte die Lage des in dem Raum verbrachten Korpers in 45 Hierbei werden sowohl interne (Zoom und Autofokus) als 

den sechs raumlichen Freiheitsgraden charakterisieren. auch externe Lagkoordinaten Parameter der Kamera beriick- 

Diese Vorgehensweise hat den Nachteil, dass entweder meh- sichtigt. 

rere Kameras benotigt werden oder eine Kamera so um den [0010] Fur Routineuntersuchungen, bspw. an einer Ferti- 

Korper bewegt werden muss, dass der gleiche Teil des Kor- gungsstraBe fur Automobile, kann es auch zweckmaBig 

pers aus verschiedenen Ansichten gesehen wird. Im letzte- 50 sein, dass die Kalibrierung der Kameras vor der eigentlichen 


ren Fall ist eine Bewegungseinheit fur die Kamera notwen- 
dig, welche die Kamera iiber langere Strecken positionieren 
muss in Abhangigkeit von der GroBe des Korpers. 
[0004] Aufgabe der vorliegenden Erfindung ist es, ein 
Verfahren der eingangs genannten Art vorzuschlagen, wel- 
ches auf einfache und wirtschaftlichere Weise ausgefiihrt 
werden kann. 

[0005] Hierzu wird im Rahmen der Erfindung bspw. vor- 
geschlagen, die Kamera mit Hilfe einer Kalibriertafel oder 


Lagebestimmung ausgefiihrt und die Kalibrierungsparame- 
ter elektronisch abgespeichert werden, so dass sie danach je- 
derzeit zur Verfiigung stehen, 

[0011] Das erfindung sgemaBe Verfahren schlieBt nicht 
55 aus, dass zur Erhohung der Genauigkeit der Lagebestim- 
mung oder zur Bestimmung der Lage sehr komplexer Kor- 
per auch mehrere auf Schwenk-Neige-Kopfen gelagerte Ka- 
meras verwendet werden. 

[0012] GemaB einem alternativen Erfindungsvorschlag 


dem Korper selbst, auf welcher bzw. welchem mehrere be- 60 wird mindestens ein Merkmal auf dem Objekt benutzt und 


kannte Zielpunkte angebracht. sind, oder mit Hilfe einer kon- 
trollierten Bewegung der Kamera und einer einzelnen 
Marke kalibriert, die Kamera wird zur Bildaufnahme mit 
Hilfe eines Schwenk-Neige-Kopfes hintereinander auf min- 
destens drei auf den Korper bestimmten Merkmale gerich- 
tet, dessen korperfeste Koordinaten jeweils bekannt sind, 
dann werden die Bildkoordinaten der drei Merkmale mit 
Hilfe der elektronischen Bildverarbeitung festgestellt und 
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dieses miter mindestens zwei verschiedenen Einstellungen 
des Schrank-Neige-Kopfes betrachtet. Dabei kann die Be- 
wegung des Schwenk-Neige-Kopf es mit zur Bestimmung 
der 3D-Lage benutzt werden. 

[0013] Weitere Ziele, Merkmale, Vorteile und Anwen- 
dungsmoglichkeiten der Erfindung ergeben sich aus der 
nachfolgenden Beschreibung von Ausfuhrungsbeispielen 
anhand der Zeichnung. Dabei bilden alle beschriebenen und/ 
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oder bildlich dargestellten Merkmale fiir sich oder in belie- 
biger Kombination den Gegenstand der Erflndung auch un- 
abhangig von ihrer Zusammenfassung in einzelnen Anspru- 
chen oder deren Ruckbeziehung. 

[0014] Ausfiihrungsbeispiele der Erflndung werden nach- 5 
folgend anhand der Zeichnung naher erlautert. 
[0015] Wie in der Zeichnung dargestellt, wird die auf ei- 
nem Schwenk-Neige-Kopf 1 montierte Kamera 2 zunachst. 
mil Hilfe einer in der Nahe angebrachten Kalibriertafel 3, 
welche mehrere Zielpunkte (Markierungen) 4 bekannter 10 
Koordinaten kalibriert. Bei dieser Kalibriemng werden die 
internen und externen Parameter der Kamera bestimmt, also 
bspw. Autofokus, Zoom und die Lagekoordinaten. Die Kali- 
brierung kann auch mit Hilfe von Zielpunkten (4) erfolgen, 
welche auf dem Objekt 5 selbst angebracht sind, dessen 15 
Lage im Raum bestimmt werden soil Es ist auch moglich, 
die Kalibriemng mit einem aquivalenten Verfahren dazu 
vorzunehmen, bspw. durch die kontrollierte Bewegung der 
Kamera 2 und der Erkennung eines einzigen Zielpunktes 
bzw. einer einzigen Markierung, 20 
[0016] Ist die Kalibrierung erfolgt, wird die Kamera 2 mit 
Hilfe des Schwenk-Neige-Kopfes 1 auf ein erstes Merkmal 
6 eingestellt. Von diesem Merkmal sind die korperfesten 
Koordinaten bekannt. Das Merkmal 6 kann punkt- oder lini- 
enformig sein. Bei einem Hnienformigen Merkmal brauchen 25 
ausgezeichnete Punkte nicht zu erkennen sein. 
[0017] Sodann wird mit Hilfe der Kamera 2 ein Bild des 
Korpers 5 mit dem ersten Merkmal 6 aufgenommen. Da- 
nach wird der Schwenk-Neige-Kopf 1 so eingestellt, dass 
von der Kamera 2 ein zweites Merkmal 6' auf den Korper 5 30 
gesehen und aufgenommen werden kann. Von dem Merk- 
mal 6' sind die korperfesten Koordinaten ebenfalls bekannt. 
Das Gleiche erfolgt mit Hilfe eines dritten Merkmals 6" auf 
dem Korper 5. 

[0018] In den drei so aufgenommenen Bildern werden die 35 
Bildkoordinaten der Merkmale 6, 6', 6" mit Hilfe einer elek- 
tronischen Bildverarbeitung bestimmt. Aus diesen kann 
dann zusammen mit den Kalibrierparametern der Kamera 2 
und den bekannten korperfesten Koordinaten der Merkmale 
6, 6', 6" die Lage des Korpers 5 im Raum bestimmt werden. 40 
[0019] Es ist auch moglich, mehr als drei Merkmale 6, 6\ 
6" fiir die Lagebestimrnung des Korpers 5 im Raum zu be- 
nutzen. Ferner ist es auch moglich, mehr als ein Merkmal 6, 
6', 6" pro Bild zu benutzen. 

[0020] Die Kamera 2 kann mit Autofokus und/oder Zoom 45 
ausgestattet sein. Zur Kalibrierung gehort dann auch die Au- 
tofokus- und/oder Zoom-Einstellung der Kamera. 
[0021] Die Kalibrierung der Kamera 2 kann auch getrennt 
von der Lagebestimrnung des Korpers 5 erfolgen, bspw. vor- 
her. Dann konnen die Kalibrierungsparameter fur alle spate- 50 
ren Anwendungen abgespeichert werden. 
[0022] Es ist auch moglich, zur Lagebestimrnung des Kor- 
pers 2 im Raum an der Kamera 2 zunachst den erforderli- 
chen Zoom einzustellen, dann die Kamera 2 zu dem ersten 
Merkmal 6 zu schwenken, die Autofokus-Einstellung 55 
durchzufuhren, die Kamera 2 auf die Kalibriertafel 3 zu 
schwenken, die notwendigen Kalibrierparameter zu bestim- 
men, dann die Kamera 2 zuruckzuschwenken und die ent- 
sprechende Messung an dem ersten Merkmal 6 durchzufuh- 
ren. Entsprechendes gilt fur die weiteren Merkmale 6', 6". 60 
[0023] Statt Verwendung der Kalibriertafel 3 kann die Ka- 
librierung auch mit Hilfe des Objektes 5 selbst durchgefuhrt 
werden, wenn dieses dazu geeignet ist, also geeignete Ziel- 
punkte 4 aufweist. 

[0024] Wenn, eine weitere Moglichkeit der Erfindung, 65 
mehrere Kameras 2 mit Schwenk-Neige-Kopf 1 eingesetzt 
werden, konnen auch teilweise oder ganz uberlappende 
Bildfelder benutzt werden. 
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Bezugszeichenliste 

1 Schwenk-Neige-Kopf 

2 Kamera 

3 Kalibriertafel 

4 Zielpunkte 

5 Korper 

6, 6*, 6" Merkmale 

Patentanspriiche 

1. Verfahren zur Bestimmung der Lage eines Korpers 
(5) im Raum unter Verwendung einer elektronischen 
Kamera (2) mit Bildverarbeitung, wobei die Kamera 
(2) mit Hilfe einer Kalibriertafel (3) oder dem Korper 
(5) selbst, auf welcher bzw. welchem mehrere bekannte 
Zielpunkte (4) angebracht sind, oder mit Hilfe einer 
kontrollierten Bewegung der Kamera (2) und einem 
einzelnen Zielpunkt (4) kalibriert wird, die Kamera (2) 
zur Bildaufnahme mit Hilfe eines Schwenk-Neige- 
Kopfes (1) hintereinander auf mindestens drei auf dem 
Korper (5) bestirnmte Merkmale (6, 6', 6") gerichtet 
wird, deren korperfeste Koordinaten jeweils bekannt 
sind, die Bildkoordinaten der drei Merkmale (6, 6', 6") 
mit Hilfe der elektronischen Bildverarbeitung festge- 
stellt werden und wobei schlieBlich aus diesen, aus den 
Kalibrierparametern der Kamera (2) und aus den be- 
kannten korperfesten Koordinaten der Merkmale (6, 6', 
6") die Lage des Korpers (5) im Raum bestimmt wird. 

2. Verfahren nach Anspruch 1, dadurch gekennzeich- 
net, dass durch Verschwenken der Kamera (2) mehr als 
drei auf dem Korper (5) bestirnmte Merkmale (6, 6', 6") 
zur Bildaufnahme benutzt werden. 

3. Verfahren nach Anspruch 1 oder 2, dadurch gekenn- 
zeichnet, dass bei einer Bildaufnahme mehr als ein auf 
dem Korper (5) bestimmtes Merkmal (6, 6', 6"), dessen 
Bildkoordinaten festgestellt werden, benutzt wird. 

4. Verfahren nach einem der vorhergehenden Anspru- 
che, dadurch gekennzeichnet, dass eine Kamera (2) mit 
Autofokus und/oder Zoom verwendet. wird, wobei fiir 
die jeweilige Bildaufnahme die entsprechenden Ein- 
stellungen der Kamera (2) mit kalibriert werden. 

5. Verfahren nach einem der vorhergehenden Anspru- 
che, dadurch gekennzeichnet, dass zunachst der erfor- 
derliche Zoom der Kamera (2) eingestellt, dann die Ka- 
mera (2) auf die entsprechenden Merkmale (6, 6', 6") 
geschwenkt und die Autofokus-Einstellung vorgenom- 
men werden, dann die Kalibrierung der Kamera (2) 
durchgefuhrt wird, indem die Kamera (2) z. B. auf die 
Kalibriertafel (3) verschwenkt wird, um die notwendi- 
gen Kalibrierparameter zu bestimmen, und dann die 
Kamera (2) auf die entsprechenden Merkmale (6, 6', 
6") des Korpers (5) zur Bildaufnahme und -auswertung 
zuriick geschwenkt wird. 

6. Verfahren nach einem der vorhergehenden Ansprii- 
che, dadurch gekennzeichnet, dass die Kalibrierung der 
Kamera (2) vor der eigentlichen Lagebestimrnung aus- 
gefuhrt und die Kalibrierparameter elektronisch abge- 
speichert werden. 

7. Verfahren nach einem der vorhergehenden Ansprii- 
che, dadurch gekennzeichnet, dass mehrere auf 
Schwenk-Neige-Kopfen (1) gelagerte Kameras (2) ver- 
wendet werden. 

8. Verfahren insbesondere nach einem der vorherge- 
henden Anspruche, dadurch gekennzeichnet, dass min- 
destens ein Merkmal (6, 6', 6") auf dem Korper (5) be- 
nutzt und dieses unter mindestens zwei verschiedenen 
Einstellungen des Schwenk-Neige-Kopfes (1) betrach- 
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tet wird. 
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